home *** CD-ROM | disk | FTP | other *** search
/ QRZ! Ham Radio 1 / QRZ Ham Radio Callsign Database - December 1993.iso / ucsd / packet / tcpip / sys5 / iscwmpst.z / iscwmpst / tcp / src / axip.c < prev    next >
Encoding:
C/C++ Source or Header  |  1991-10-04  |  8.8 KB  |  355 lines
  1. /* @(#) $Header: axip.c,v 1.3 91/10/03 11:04:56 deyke Exp $ */
  2.  
  3. #include <sys/types.h>
  4.  
  5. #include <netinet/in.h>
  6. #include <netinet/in_systm.h>
  7. #include <netinet/ip.h>
  8. #include <stdio.h>
  9. #include <stdlib.h>
  10. #include <string.h>
  11. #include <sys/socket.h>
  12.  
  13. #undef IPPROTO_IP
  14.  
  15. extern char *sys_errlist[];
  16. extern int errno;
  17.  
  18. #include "global.h"
  19. #include "mbuf.h"
  20. #include "iface.h"
  21. #include "timer.h"
  22. #include "netuser.h"
  23. #include "ax25.h"
  24. #include "socket.h"
  25. #include "trace.h"
  26. #include "pktdrvr.h"
  27. #include "cmdparse.h"
  28. #include "hpux.h"
  29.  
  30. #define MAX_FRAME       2048
  31.  
  32. struct axip_route {
  33.   char call[AXALEN];
  34.   struct sockaddr_in addr;
  35.   struct axip_route *next;
  36. };
  37.  
  38. static int sock = -1;
  39. static struct axip_route *Axip_routes;
  40. static struct iface *Axip_iface;
  41.  
  42. static int axip_raw __ARGS((struct iface *iface, struct mbuf *data));
  43. static void axip_recv __ARGS((void *argp));
  44. static void axip_route_add __ARGS((char *call, const struct sockaddr_in *addr));
  45. static int doaxiproute __ARGS((int argc, char *argv [], void *p));
  46. static int doaxiprouteadd __ARGS((int argc, char *argv [], void *p));
  47. static int doaxiproutedrop __ARGS((int argc, char *argv [], void *p));
  48.  
  49. /*---------------------------------------------------------------------------*/
  50.  
  51. static int16 fcstab[256] = {
  52.   0x0000, 0x1189, 0x2312, 0x329b, 0x4624, 0x57ad, 0x6536, 0x74bf,
  53.   0x8c48, 0x9dc1, 0xaf5a, 0xbed3, 0xca6c, 0xdbe5, 0xe97e, 0xf8f7,
  54.   0x1081, 0x0108, 0x3393, 0x221a, 0x56a5, 0x472c, 0x75b7, 0x643e,
  55.   0x9cc9, 0x8d40, 0xbfdb, 0xae52, 0xdaed, 0xcb64, 0xf9ff, 0xe876,
  56.   0x2102, 0x308b, 0x0210, 0x1399, 0x6726, 0x76af, 0x4434, 0x55bd,
  57.   0xad4a, 0xbcc3, 0x8e58, 0x9fd1, 0xeb6e, 0xfae7, 0xc87c, 0xd9f5,
  58.   0x3183, 0x200a, 0x1291, 0x0318, 0x77a7, 0x662e, 0x54b5, 0x453c,
  59.   0xbdcb, 0xac42, 0x9ed9, 0x8f50, 0xfbef, 0xea66, 0xd8fd, 0xc974,
  60.   0x4204, 0x538d, 0x6116, 0x709f, 0x0420, 0x15a9, 0x2732, 0x36bb,
  61.   0xce4c, 0xdfc5, 0xed5e, 0xfcd7, 0x8868, 0x99e1, 0xab7a, 0xbaf3,
  62.   0x5285, 0x430c, 0x7197, 0x601e, 0x14a1, 0x0528, 0x37b3, 0x263a,
  63.   0xdecd, 0xcf44, 0xfddf, 0xec56, 0x98e9, 0x8960, 0xbbfb, 0xaa72,
  64.   0x6306, 0x728f, 0x4014, 0x519d, 0x2522, 0x34ab, 0x0630, 0x17b9,
  65.   0xef4e, 0xfec7, 0xcc5c, 0xddd5, 0xa96a, 0xb8e3, 0x8a78, 0x9bf1,
  66.   0x7387, 0x620e, 0x5095, 0x411c, 0x35a3, 0x242a, 0x16b1, 0x0738,
  67.   0xffcf, 0xee46, 0xdcdd, 0xcd54, 0xb9eb, 0xa862, 0x9af9, 0x8b70,
  68.   0x8408, 0x9581, 0xa71a, 0xb693, 0xc22c, 0xd3a5, 0xe13e, 0xf0b7,
  69.   0x0840, 0x19c9, 0x2b52, 0x3adb, 0x4e64, 0x5fed, 0x6d76, 0x7cff,
  70.   0x9489, 0x8500, 0xb79b, 0xa612, 0xd2ad, 0xc324, 0xf1bf, 0xe036,
  71.   0x18c1, 0x0948, 0x3bd3, 0x2a5a, 0x5ee5, 0x4f6c, 0x7df7, 0x6c7e,
  72.   0xa50a, 0xb483, 0x8618, 0x9791, 0xe32e, 0xf2a7, 0xc03c, 0xd1b5,
  73.   0x2942, 0x38cb, 0x0a50, 0x1bd9, 0x6f66, 0x7eef, 0x4c74, 0x5dfd,
  74.   0xb58b, 0xa402, 0x9699, 0x8710, 0xf3af, 0xe226, 0xd0bd, 0xc134,
  75.   0x39c3, 0x284a, 0x1ad1, 0x0b58, 0x7fe7, 0x6e6e, 0x5cf5, 0x4d7c,
  76.   0xc60c, 0xd785, 0xe51e, 0xf497, 0x8028, 0x91a1, 0xa33a, 0xb2b3,
  77.   0x4a44, 0x5bcd, 0x6956, 0x78df, 0x0c60, 0x1de9, 0x2f72, 0x3efb,
  78.   0xd68d, 0xc704, 0xf59f, 0xe416, 0x90a9, 0x8120, 0xb3bb, 0xa232,
  79.   0x5ac5, 0x4b4c, 0x79d7, 0x685e, 0x1ce1, 0x0d68, 0x3ff3, 0x2e7a,
  80.   0xe70e, 0xf687, 0xc41c, 0xd595, 0xa12a, 0xb0a3, 0x8238, 0x93b1,
  81.   0x6b46, 0x7acf, 0x4854, 0x59dd, 0x2d62, 0x3ceb, 0x0e70, 0x1ff9,
  82.   0xf78f, 0xe606, 0xd49d, 0xc514, 0xb1ab, 0xa022, 0x92b9, 0x8330,
  83.   0x7bc7, 0x6a4e, 0x58d5, 0x495c, 0x3de3, 0x2c6a, 0x1ef1, 0x0f78
  84. };
  85.  
  86. /*---------------------------------------------------------------------------*/
  87.  
  88. static int axip_raw(iface, data)
  89. struct iface *iface;
  90. struct mbuf *data;
  91. {
  92.  
  93.   char **mpp;
  94.   char *dest;
  95.   char *p;
  96.   char buf[MAX_FRAME];
  97.   int cnt;
  98.   int l;
  99.   int multicast;
  100.   int16 fcs;
  101.   struct axip_route *rp;
  102.   struct mbuf *bp;
  103.  
  104.   dump(iface, IF_TRACE_OUT, iface->type, data);
  105.   iface->rawsndcnt++;
  106.   iface->lastsent = secclock();
  107.  
  108.   fcs = 0xffff;
  109.   for (bp = data; bp; bp = bp->next) {
  110.     p = bp->data;
  111.     for (cnt = bp->cnt; cnt > 0; cnt--)
  112.       fcs = (fcs >> 8) ^ fcstab[(fcs ^ *p++) & 0xff];
  113.   }
  114.   fcs ^= 0xffff;
  115.   bp = ambufw(2);
  116.   bp->data[0] = fcs;
  117.   bp->data[1] = fcs >> 8;
  118.   bp->cnt = 2;
  119.   append(&data, bp);
  120.  
  121.   if (iface->trace & IF_TRACE_RAW)
  122.     raw_dump(iface, -1, data);
  123.  
  124.   l = pullup(&data, buf, sizeof(buf));
  125.   if (l <= 0 || data) {
  126.     free_p(data);
  127.     return (-1);
  128.   }
  129.  
  130.   dest = buf;
  131.   p = dest + AXALEN;
  132.   while (!(p[6] & E)) {
  133.     p += AXALEN;
  134.     if (!(p[6] & REPEATED)) {
  135.       dest = p;
  136.       break;
  137.     }
  138.   }
  139.  
  140.   multicast = 0;
  141.   for (mpp = Axmulti; *mpp; mpp++) {
  142.     if (addreq(dest, *mpp)) {
  143.       multicast = 1;
  144.       break;
  145.     }
  146.   }
  147.   for (rp = Axip_routes; rp; rp = rp->next)
  148.     if (multicast || addreq(rp->call, dest))
  149.       sendto(sock, buf, l, 0, (struct sockaddr *) & rp->addr, sizeof(rp->addr));
  150.  
  151.   return l;
  152. }
  153.  
  154. /*---------------------------------------------------------------------------*/
  155.  
  156. static void axip_recv(argp)
  157. void *argp;
  158. {
  159.  
  160.   char *bufptr;
  161.   char *p;
  162.   char *src;
  163.   char buf[MAX_FRAME];
  164.   int cnt;
  165.   int fromlen;
  166.   int hdr_len;
  167.   int l;
  168.   int16 fcs;
  169.   struct ip *ipptr;
  170.   struct sockaddr_in from;
  171.  
  172.   fromlen = sizeof(from);
  173.   l = recvfrom(sock, buf, sizeof(buf), 0, (struct sockaddr *) & from, &fromlen);
  174.   if (l <= sizeof(struct ip )) goto fail;
  175.   ipptr = (struct ip *) buf;
  176.   hdr_len = 4 * ipptr->ip_hl;
  177.   bufptr = buf + hdr_len;
  178.   l -= hdr_len;
  179.   if (l <= 2) goto fail;
  180.  
  181.   fcs = 0xffff;
  182.   p = bufptr;
  183.   for (cnt = l; cnt > 0; cnt--)
  184.     fcs = (fcs >> 8) ^ fcstab[(fcs ^ *p++) & 0xff];
  185.   if (fcs != 0xf0b8) goto fail;
  186.   l -= 2;
  187.  
  188.   p = src = bufptr + AXALEN;
  189.   while (!(p[6] & E)) {
  190.     p += AXALEN;
  191.     if (p[6] & REPEATED)
  192.       src = p;
  193.     else
  194.       break;
  195.   }
  196.   axip_route_add(src, &from);
  197.  
  198.   net_route(Axip_iface, Axip_iface->type, qdata(bufptr, l));
  199.   return;
  200.  
  201. fail:
  202.   Axip_iface->crcerrors++;
  203. }
  204.  
  205. /*---------------------------------------------------------------------------*/
  206.  
  207. int axip_attach(argc, argv, p)
  208. int argc;
  209. char *argv[];
  210. void *p;
  211. {
  212.  
  213.   if (Axip_iface) {
  214.     tprintf("axip interface already attached\n");
  215.     return (-1);
  216.   }
  217.  
  218.   sock = socket(AF_INET, SOCK_RAW, IPPROTO_AX25);
  219.   if (sock < 0) {
  220.     tprintf("cannot create raw socket: %s\n", sys_errlist[errno]);
  221.     return (-1);
  222.   }
  223.  
  224.   Axip_iface = callocw(1, sizeof(struct iface ));
  225.   Axip_iface->addr = Ip_addr;
  226.   Axip_iface->name = strdup("axip");
  227.   Axip_iface->hwaddr = mallocw(AXALEN);
  228.   addrcp(Axip_iface->hwaddr, Mycall);
  229.   Axip_iface->mtu = 256;
  230.   setencap(Axip_iface, "AX25");
  231.   Axip_iface->raw = axip_raw;
  232.   Axip_iface->sendcrc = 1;
  233.   on_read(sock, axip_recv, (void * ) 0);
  234.   Axip_iface->next = Ifaces;
  235.   Ifaces = Axip_iface;
  236.  
  237.   return 0;
  238. }
  239.  
  240. /*---------------------------------------------------------------------------*/
  241.  
  242. static void axip_route_add(call, addr)
  243. char *call;
  244. const struct sockaddr_in *addr;
  245. {
  246.   struct axip_route *rp;
  247.  
  248.   for (rp = Axip_routes; rp && !addreq(rp->call, call); rp = rp->next) ;
  249.   if (!rp) {
  250.     rp = malloc(sizeof(*rp));
  251.     addrcp(rp->call, call);
  252.     rp->next = Axip_routes;
  253.     Axip_routes = rp;
  254.   }
  255.   rp->addr = *addr;
  256. }
  257.  
  258. /*---------------------------------------------------------------------------*/
  259.  
  260. static struct cmds Axipcmds[] = {
  261.   "route",  doaxiproute, 0, 0, NULLCHAR,
  262.   NULLCHAR, NULLFP,      0, 0, NULLCHAR
  263. };
  264.  
  265. int doaxip(argc, argv, p)
  266. int argc;
  267. char *argv[];
  268. void *p;
  269. {
  270.   return subcmd(Axipcmds, argc, argv, p);
  271. }
  272.  
  273. /*---------------------------------------------------------------------------*/
  274.  
  275. static struct cmds Axiproutecmds[] = {
  276.   "add",    doaxiprouteadd,  0, 3, "axip route add <call> <host>",
  277.   "drop",   doaxiproutedrop, 0, 2, "axip route drop <call>",
  278.   NULLCHAR, NULLFP,          0, 0, NULLCHAR
  279. };
  280.  
  281. static int doaxiproute(argc, argv, p)
  282. int argc;
  283. char *argv[];
  284. void *p;
  285. {
  286.  
  287.   char buf[AXBUF];
  288.   struct axip_route *rp;
  289.  
  290.   if (argc >= 2)
  291.     return subcmd(Axiproutecmds, argc, argv, p);
  292.  
  293.   tprintf("Call       Addr\n");
  294.   for (rp = Axip_routes; rp; rp = rp->next)
  295.     tprintf("%-9s  %s\n",
  296.         pax25(buf, rp->call),
  297.         inet_ntoa(ntohl(rp->addr.sin_addr.s_addr)));
  298.   return 0;
  299. }
  300.  
  301. /*---------------------------------------------------------------------------*/
  302.  
  303. static int doaxiprouteadd(argc, argv, p)
  304. int argc;
  305. char *argv[];
  306. void *p;
  307. {
  308.  
  309.   char call[AXALEN];
  310.   int32 ipaddr;
  311.   struct sockaddr_in addr;
  312.  
  313.   if (setcall(call, argv[1])) {
  314.     printf("Invalid call \"%s\"\n", argv[1]);
  315.     return 1;
  316.   }
  317.   if (!(ipaddr = resolve(argv[2]))) {
  318.     printf(Badhost, argv[2]);
  319.     return 1;
  320.   }
  321.   memset(&addr, 0, sizeof(addr));
  322.   addr.sin_family = AF_INET;
  323.   addr.sin_addr.s_addr = htonl(ipaddr);
  324.   axip_route_add(call, &addr);
  325.   return 0;
  326. }
  327.  
  328. /*---------------------------------------------------------------------------*/
  329.  
  330. static int doaxiproutedrop(argc, argv, p)
  331. int argc;
  332. char *argv[];
  333. void *p;
  334. {
  335.  
  336.   char call[AXALEN];
  337.   struct axip_route *rp, *pp;
  338.  
  339.   if (setcall(call, argv[1])) {
  340.     printf("Invalid call \"%s\"\n", argv[1]);
  341.     return 1;
  342.   }
  343.   for (pp = 0, rp = Axip_routes; rp; pp = rp, rp = rp->next)
  344.     if (addreq(rp->call, call)) {
  345.       if (pp)
  346.     pp->next = rp->next;
  347.       else
  348.     Axip_routes = rp->next;
  349.       free(rp);
  350.       break;
  351.     }
  352.   return 0;
  353. }
  354.  
  355.